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INTRODUCTION 


A  useful  and  practical  approach  to  the  control  of  mechanisms  for  many 
robotic  and  automation  applications  is  switching  zone  control  (SZC)  (refs  1-4). 
Switching  zone  control  is  a  robust  nonlinear  feedback  controller  with  the 
following  characteristics.-  (1)  it  is  a  decentralized  controller  where  each 
motor/actuator  of  a  multidegree  of  freedom  system  can  be  separately  operated 
with  its  own  electronic  or  digital  controller  (coupling  is  handled  as  a 
disturbing  torque);  (2)  it  yields  near  minimum  time  which  approaches  the  bang- 
bang  minimum  time  controller  in  the  limit;  (3)  the  designer  can  specify  the  peak 
torques  applied  by  the  motor  to  solve  saturation  problems;  (4)  the  designer  can 
specify  the  maximum  velocity  when,  for  example,  motors  used  have  limited  horse¬ 
power;  and  (5)  the  controller  is  easy  to  program  using  digital  or  electronic 
hardware.  The  SZC  approach  eliminates  the  usual  problems  of  overshoot  and 
instability  inherent  in  high  gain  linear  feedback  systems  where  saturation  of 
motors  and/or  amplifiers  becomes  a  problem. 

This  report  presents  extensions  of  SZC  to  a  mechanical  system  with  elastic 
joints.  The  elastic  joint  is  the  simplest  idealization  of  the  elastic  flexible 
robotic  mechanism  which  is  a  natural  extension  of  SZC.  A  summary  of  the  main 
results  and  contributions,  the  details  of  which  are  presented  later  in  this 
report,  are  given  as  follows: 

1.  Stability  of  a  system  with  an  elastic  joint  is  achieved  through  the 
use  of  both  co- located  and  endpoint  feedback. 

2.  Although  a  single  actuator  system  with  an  elastic  joint  is  inherently 
a  fourth  order  system,  a  second  order  system  approximation  is 
satisfactory  in  estimating  SZC  parameters.  This  greatly  simplifies  the 
implementation  of  SZC. 

References  are  listed  at  the  end  of  this  report. 
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3.  A  simple  approach  is  used  for  adaptive  real-time  feedforward  compen¬ 
sation  of  gravity,  friction,  and  other  disturbing  torque  effects. 

4.  Simulation  and  experimental  results  of  a  simple  one-degree  of  freedom 
system  demonstrate  the  application  of  the  proposed  approach  to  a 
highly  flexible  joint  case. 

The  remainder  of  this  report  is  organized  as  follows:  A  brief  summary  of 
SZC  for  a  simple  second  order  system  is  presented.  Next,  the  addition  of  an 
elastic  joint  between  the  motor  or  actuator  and  the  payload  is  considered  as  are 
its  ramifications  on  stability.  A  straightforward  approach  is  presented  for 
stabilizing  the  resulting  system.  The  determination  of  SZC  parameters  is  then 
considered  where  the  second  order  system  approximation  is  found  to  provide  an 
adequate  controller.  Then,  experimental  results  are  presented  which  demonstrate 
the  application  of  the  proposed  approach  to  a  highly  flexible  joint  case. 
Finally,  a  simple  method  is  presented  for  handling  the  real-time  compensation  of 
gravity,  friction,  and  other  disturbing  torque  effects  that  are  nonzero  in  the 
steady-state  limit. 

SWITCHING  ZONE  CONTROL 

The  basis  of  SZC  is  a  time  optimal  bang-bang  theory  where  maximum  effort  is 
applied  to  motors  in  both  negative  and  positive  directions  (accelerating  and 
decelerating  phases)  to  move  a  mechanism  from  one  state  to  another  in  minimum 
time  (refs  1-4).  Xia  and  Chang  (ref  1)  presented  in  detail  the  modifications  to 
the  bang-bang  control  theory  which  are  necessary  for  practical  applications. 

They  proposed  controlling  each  link  or  degree  of  freedom  of  a  robotic  system  in 
a  decentralized  fashion.  Instead  of  a  switching  boundary  as  used  in  the  bang- 
bang  approach,  a  switching  zone  is  used  whereby  the  torque  varies  linearly. 
Outside  this  zone,  the  torque  takes  on  the  maximum  allowable  values  as  in  bang- 
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bang.  In  addition,  the  decelerating  phase  starts  at  a  lower  value  of  speed  so 
that  only  a  fraction  of  the  available  torque  is  needed  to  guide  the  system  along 
its  decelerating  trajectory  without  overshoot. 

Equation  (1)  shows  a  simple  second  order  system  where  all  of  the 
interlinking  coupling  terms  of  a  multi link  system,  as  well  as  gravity  and  fric¬ 
tion  effects,  are  considered  as  a  single  disturbing  force,  U(j^ 

Ji0  =  ucji(e,0,9)  +  u,  (1) 

where 

J-j  =  inertia  of  the  ith  link 

9i  s  angular  position  of  the  ith  link 

Ui  =  motor  torque  at  the  ith  link 

=  disturbing  torque  which  includes  Coriolis,  centrifugal,  gravity, 
and  friction  coupling  effects. 

(0,0,0)  »  vectors  of  position,  velocity,  and  acceleration  for  a  multi  link 
system. 

A  schematic  diagram  of  the  nonlinear  switching  zone  controller  for  a  typi¬ 
cal  link  is  shown  in  Figure  1  where  the  subscript  i  has  been  dropped.  The 
"plant"  in  Figure  1  can  be  the  simple  second  order  system  given  as  Eq.  (1)  or  a 
more  complicated  plant  as  discussed  later  in  this  report.  The  variables  0p  and 
0p  in  the  figure  are  the  desired  reference  angle  and  velocity;  e  and  e  are  the 
error  functions;  and  the  nonlinear  blocks  Nj,  N2,  N3,  and  N4  are  defined  as 
follows  (?  s  input  variable,  n  =  output  variable); 

rj  =  kj^  for  I  5  I  <  UmAi 

N^:  n  =  Um  for  {  >  u^/ki  (2) 

r?  »  -u„  for  ?  <  -Un,/ki 
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The  constants  kj,  k2,  a,  b,  Um,  v*,  V,  and  are  the  controller  gains  and 
paraneters  that  need  to  be  specified  by  the  designer.  These  constants  for  the 
second  order  plant  of  Eq.  (1)  are  defined  as  follows: 


■ 


Ua 


b 


where 


■  nonlinear  function  term  selected  to  guarantee  sufficient  torque  at 
deceleration, 

*  (Ug  -  U(j|g)/u,g  where  u^j^  is  the  awxiiiium  value  of  u^j  (6) 

•  constant  selected  to  guarantee  no  overshoot, 

■  «ax(Un|/ki  or  k2  au,||Xi/(ki(Xik2-l) ) )  (7) 


^  kik2  ♦  i'(kik2)*  -  4kiJ 

Xi  - - - - 


(8) 


Vq,  a  maximuffi  allowable  velocity 

V  a  constant  chosen  to  smoothly  maintain  maximum  velocity  near  v„ 

ki.k2  ■  proportional  and  velocity  gains  where  k2  >  2YJ/ki  is  required  for 
no  overshoot 

The  maximum  torque  u^,  can  be  specified  arbitrarily  or  can  be  fixed  based  on  the 
motor/amplifier  specifications.  The  gain  kj  is  fixed  high  and  is  limited  pri¬ 
marily  by  the  requirement  for  no  system  chatter/jitters,  which  are  common 
effects  in  pure  bang-bang  control.  Infinite  gain  kj  reduces  the  control  to 
switching  boundary  or  bang-bang. 

A  better  understanding  of  the  characteristics  of  the  above  described  SZC 
can  be  obtained  by  examining  the  resulting  phase  diagram  for  the  second  order 
system.  Figure  2  is  a  plot  of  9  versus  9  where  u^  in  Eq.  (1)  is  assumed  to  be 
zero.  The  system  with  nonzero  u^  is  considered  later  in  this  report.  The 
controller  in  this  case  is  designed  to  drive  any  given  nonzero  state  toward  the 
origin.  For  example,  if  the  initial  state  in  Figure  2  starts  at  point  A,  maxi¬ 
mum  torque  u  »  u,,  is  applied  at  first.  The  path  then  eventually  enters  the  zone 
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between  fu11  negative  and  positive  torques.  Once  in  the  zone,  the  state  is  cap¬ 
tured  and  is  driven  to  the  origin  with  little  or  no  overshoot  (see  Reference  1 
for  details).  Xia  and  Chang  (ref  1)  and  Jeng  (ref  3),  as  well  as  these  investi¬ 
gators  have  found  this  approach  to  be  very  effective,  even  in  the  presence  of 
Minor  tiae  delays  and  paraaeter  inaccuracies. 


Figure  2.  Phase  diagram  for  switching  zone  control  system  showing 
typical  trajectory. 

SYSTEM  WITH  ELASTIC  JOINT 

In  this  section,  the  ramifications  of  including  an  elastic  joint  between 
the  motor  and  the  payload  on  the  design  of  a  switching  zone  controller  are  con¬ 
sidered.  This  is  perhaps  the  simplest  case  of  the  compliant/flexible  manipula¬ 
tor.  There  is  considerable  interest  at  the  present  time  in  controlling 
lightweight,  flexible  mechanical  systems,  particularly  in  nonindustrial  applica¬ 
tions  such  as  space  or  military  where  weight  and  speed  of  operation  become 
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critical  factors.  The  totally  elastic/flexible  arm  is  an  infinite  degree  of 
freedom  system  which,  in  the  simplest  idealization,  reduces  to  the  fourth  order 
spring-mass  system  shown  in  Figure  3.  The  four  state  variables  for  this  case 


/ 

/ 


Figure  3.  Schematic  diagram  of  system  with  elastic  joint, 
include  the  position  and  velocity  of  both  the  motor  and  endpoint  payload 
(01,9l,9o,0o  in  Figure  3).  The  motor  with  internal  rotor  inertia  Jq  and  damping 
Bq  drives  through  a  spring  of  constant  to  reposition  a  mass  of  inertia  Jj  and 
damping  Bj.  The  open-loop  transfer  function  for  this  case  is  shown  schemati¬ 
cally  in  Figure  4  where 


kr/H2(s) 

( jos*+Boi+kp)( jii*+Bis+kp)~-~kp* 


(9) 


kp 

H2(s}  =  (j'iiiBjs^kpT 


(10) 


MOTOR 


SPRING-MASS 

ENDPOINT 


Figure  4.  Open-loop  block  diagram  of  fourth  order  spring-mass  system. 

In  general,  the  closed- loop  linear  feedback  for  this  case  using  only  end¬ 
point  information  is  unstable.  In  order  to  assure  stability,  co-located  motor 
velocity  feedback  is  required  in  addition  to  payload  position  and  velocity. 

These  authors  found  that  the  most  effective  configuration  leading  to  stability 
for  the  elastic  joint  case  is  shown  in  Figure  5.  The  resulting  closed-loop 
transfer  function  for  linear  feedback  is  given  as  Eq.  (11) 

Hcl(s)  =  l/(a4S*+a3S»+a2S*+ais+ao)  (11) 

where 

®  Jo^l/kp 

83  =  ( Jo®l'*'Jl(Bo-*-Cv)  )/kp 

83  ®  Jo''‘'^l'*’®l(®0'''Cv)/l^r 

*1  ®  B^+Bo+Ky 

aq  ®  l^p 

The  Routh-Hurwitz  stability  conditions  (ref  5)  for  this  system  become 


Condition  1: 

bj  «  a2  -  a4ai/a3  >  0 

(12) 

Condition  2: 

*1  ”  «3®o/bi  >  0 

(13) 
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Figure  5.  Closed-loop  block  diagram  of  spring-mass  system 
for  linear  feedback. 

For  low  motor  and  payload  damping.  Condition  1  reduces  to 

Cy/Kv  >  1/(1  +  Ji/Jq)  (14) 

plus  a  condition  on  Kp.  In  this  instance  if  payload  inertia  Jj  is  considerably 
greater  than  motor  inertia  Jq,  which  is  a  common  occurrence,  then  Cy  can  be 
quite  small  in  comparison  to  Ky. 

The  next  question  of  interest  is  how  to  best  apply  the  SZC  to  the  elastic 
joint  system  just  described.  The  most  successful  approach  studied  thus  far  for 
practical  and  relatively  flexible  mechanisms  is  shown  in  Figure  6  in  which  SZC 
is  of  the  same  configuration  as  in  Figure  1.  In  the  linear  region  of  SZC  the 
principal  poles  are  very  close  to  the  poles  of  the  simple  second  order  system. 
This  suggests  as  a  starting  point  to  use  the  second  order  approximation  for 
estimating  SZC  parameters.  This  indeed  turns  out  to  be  a  good  approach  based  on 
extensive  simulations  and  some  experimental  results. 
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Figure  6.  Block  diagram  of  switching  zone  control  system  for  fourth  order 
spring-mass  system. 

For  the  desired  no-overshoot  condition,  the  feedback  gain  requirements  are 
estimated  assuming  a  second  order  system  in  which  the  constants  in  Eq.  (11)  are 
given  as  follows: 

84  s  as  a:  0.0 

a2  a  Jq  +  a 

ai  s  81  +  Bq  +  Kv  =  +  Ky 

ao  =  Kp  (15) 

The  gain  Kp  is  fixed  by  requiring  the  maximum  torque  Um  to  be  applied  by 
the  motor  at  zero  velocity  for  some  given  minimum  angular  error  difference  Ae, 
that  is, 

•^p  •  ^m/A®  (16) 

The  characteristic  roots  for  this  system  are  given  as 
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(17) 


Therefore,  for  critical  damping,  the  expression  under  the  square  root  sign  in 
Eq.  (17)  is  set  to  zero  from  which  the  following  is  obtained: 

Kp  .  (Bt+Kv)»/(4Jt)  (18) 

Solving  this  equation  for  Ky  for  given  Kp  (Eq.  (16))  then  gives 

s  2/KpJt  -  Bt  (19) 

Finally,  the  gain  in  Figure  6  is  fixed  at  some  small  fraction  of  (say  0.1 
to  0.01  of  Ky).  The  other  SZC  parameters  are  as  given  previously  in  Eqs.  (6) 
through  (8)  where  in  these  equations  Kp  a  kj  and  Ky  « 

Experimental  application  of  the  derived  SZC  for  an  elastic  joint  case  is 
considered  in  the  next  section. 

EXPERIHENTAL  RESULTS 

Simulation  of  the  fourth  order  elastic  joint  system  presented  in  the  pre¬ 
vious  section  using  the  Runge-Kutta  method  for  the  solution  of  the  equations  of 
motion  confirms  the  stability,  no-overshoot,  and  robustness  characteristics  of 
using  SZC  for  a  wide  variety  of  cases.  In  addition  to  simulation,  a  number  of 
experiments  were  conducted  on  a  one-degree  of  freedom  system  depicted  schemati¬ 
cally  in  Figure  3.  The  nominal  physical  parameters  for  the  motor-spring-mass 
system  studied  are  summarized  as  follows: 

Motor  Parameters:  Electro-Craft  0588-33-500  motor 

(from  specifications)  Jq  =  0.001  in. -lb-sec* /rad 

Bq  m  0.01  in. -lb-sec/ rad 
Peak  static  torque  *  3.0  in. -lb 

Payload-Mass  Parameters:  Jj  ■  0.030  in.-lb-sec*/rad 

(measured)  Bj  »  0.05  in.-lb-sec/rad 

Spring  Constant  (measured):  k^  »  2.0  in.-lb/rad 


Endpoint  Angle^ Degrees 


The  nominal  spring  kp  is  relatively  soft,  which  gives  a  natural  frequency 
of  vibration  of  about  1.3  cycles  per  second.  The  motor  current  (torque)  was  the 
controlled  input  signal  in  these  experiments,  where  static  torque  saturation 
occurs  at  about  3.0  in. -lb.  In  the  switching  zone  controller,  Uq,,  the  maximum 
torque,  can  be  specified.  Figure  7  shows  results  of  varying  the  maximum  torque 
from  Ugi  a  0.4  to  2.8  in. -lb.  The  remaining  SZC  parameters  used  in  this  study 
are  given  as  *  O.OOS,  a  »  1.0,  b  »  0.12,  Kp  »  3.3,  and  Ky  «  0.3.  The  initial 
angle  was  -120  degrees  and  the  desired  final  angle  was  0.0  degrees.  For  these 
trials  a  digital  controller  was  used  with  a  100  Hz  sampling  rate  (10  msec  sample 
interval ) . 


Figure  7.  Switching  zone  control  response  of  system  with  flexible  joint: 
effect  of  maximum  torque  u,,,  in. -lbs. 
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Experimental  results  indicate  that  for  no  motor  velocity  feedback  (that  is, 
Cy  »  0.0)  the  elastic  joint  system  is  highly  unstable  as  previously  discussed. 

A  value  of  Cy  «  0.005  stabilized  the  system  for  all  of  the  runs  conducted.  The 
switching  zone  controller  yielded  excellent  results  as  indicated  in  Figure  7. 

It  can  be  seen  from  this  figure  that  as  u^  is  increased  toward  the  true  satura¬ 
tion  limit,  the  cycle  time  is  continously  decreased,  all  without  significant 
overshoot.  Figure  8  shows  the  switching  zone  controller  for  Uq,  =  2.8  compared 


Figure  8.  Linear  feedback-only — comparison  to  switching  zone  control 
for  Um  a  2.8  in. -lbs. 

to  the  feedback-only  case  where  different  gains  were  assumed.  A  proportional 
gain  Kp  greater  than  2.5  or  Ky  greater  than  0.2  resulted  in  large,  sometimes 
unstable,  vibrations  for  the  feedback-only  case.  This  compares  to  Kp  *  3.3  and 
Ky  =  0.3  for  the  switching  zone  controller.  The  main  problem  with  using 
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feedback-only  was  that  for  high  gains,  saturation  is  inadvertently  reached 
during  the  cycle  resulting  in  excessive  vibrations  and  overshoot.  The  switching 
zone  controller,  on  the  other  hand,  assumes  the  existence  of  a  saturation  point 
and  accounts  for  it  automatically  in  the  repositioning  of  a  mechanism. 

NONZERO  STEADY-STATE  DISTURBING  TORQUE 

In  the  derivation  of  SZC  it  was  assumed  that  the  disturbing  torque  U(j  was 
zero  in  the  limit.  This  is  generally  not  the  case  where  gravity,  friction,  and 
other  effects  result  in  nonzero  steady-state  disturbances.  Consequently, 
steady-state  motor  torques  are  required  to  overcome  these  disturbances  in  order 
to  maintain  a  desired  payload  or  mechanism  position  or  state.  However,  the 
disturbing  torque  cannot  be  predicted  beforehand  since  friction  effects  vary 
from  cycle  to  cycle  and  unknown  gravity  effects  may  be  present.  The  nonpredict¬ 
ability  of  the  gravity  effects  is  especially  true  when  the  payload  varies  in 
a  random  fashion  or  when  a  mechanism  is  placed  on  a  moving  vehicle  where  orien¬ 
tation  varies. 

The  most  successful  and  easiest  approach  used  in  these  studies  was  to  com¬ 
pute  the  real-time  feedforward  term  that  automatically  cancels  any  steady-state 
disturbing  torques  present  (ref  5).  An  efficient  way  of  accomplishing  this  is 
to  compute  both  the  work  performed  by  the  motor  as  well  as  the  momentum  change 
over  a  short  period  of  time.  Integrating  Eq.  (1)  over  the  small  time  interval 
(tQ.t)  gives 

J(0(t)  -  0(to))  =  u(t)dt  +  Ud*(t-to)  (20) 

^0 

in  which  u^j  is  an  approximate  average  value  of  the  disturbing  torque  over  the 
time  interval  At  =  (t-tg).  Solving  for  ug  yields 

Ud  •  (J(0(t)  -  e(to))  -  u(t)dt)/At  (21) 

^0 
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The  quantities  on  the  right-hand  side  of  Eq.  (21)  are  known  or  can  be  cowputed 
in  real  tine  and  consequently  u^  can  be  calculated  in  real  time.  A  feedforward 
tern  can  then  be  added  directly  to  the  input  for  the  motor,  effectively  counter¬ 
balancing  steady-state  disturbances  in  real  time. 

In  the  experimental  runs  discussed  in  the  previous  section.  At  equal  to  50 
msec  (five  times  the  sampling  interval  of  10  msec)  was  used.  This  was  more  than 
adequate  to  accurately  estimate  the  steady-state  disturbing  torque  caused  by 
payload  changes  and  sliding  friction  effects. 

SUMHARY  AM)  CONCLUSIONS 

This  report  presented  an  extension  of  the  switching  zone  controller  to  the 
flexible  joint  case.  It  outlined  and  demonstrated  experimentally  an  approach 
which  overcomes  problems  with  stability,  overshoot,  and  robustness  inherent  in 
feedback-only  approaches  in  which  saturation  is  a  problem.  Switching  zone 
control  is  based  on  the  time  optimal  bang-bang  theory  where  instead  of  a 
switching  boundary,  a  switching  zone  is  used  to  smoothen  out  transitions  between 
accelerating  and  decelerating  phases. 

The  main  results  of  this  work  were  outlined  in  the  Introduction  of  this 
report.  Basically,  a  procedure  was  presented  for  applying  SZC  to  a  single¬ 
degree  of  freedom  system  with  a  highly  flexible  elastic  joint  between  the  motor 
and  payload.  Problems  of  stability,  controller  design,  and  nonzero  steady-state 
disturbances  were  resolved  for  the  specific  systems  studied  experimentally. 
Extensions  to  other  systems  should  be  straightforward.  Future  work  will  include 
application  of  SZC  to  multidegree  of  freedom  flexible  systems. 
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